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Die Erfindung betrifft ein Verfahren zur Eichung eines Systems zur 
Formerfassung. das eine bewegliche Sensoreinheit enthait. die in der Lage ist, die 
absoluten Koordinaten (x. y, z). die die Form eines dreidimensionalen Objektes in 
einem absolut genannten Bezugssystem (X. Y, Z) reprasentieren, auszugeben; das 
erfindungsgemSRe Verfahren zielt darauf ab. die globale Transfertfunktion 
zwischen sogenannten Rohinformationen. die die Sensoreinheit des Erfassungs- 
systems liefert. und den tatsachlichen Koordinaten (x. y. z) der Oberflache des 
Objektes. das gerade erfaftt wird. aufzustellen. Die Erfindung erstreckt sich auf 
das Erfassungssystem. das die Ausfuhrung des betreffenden Verfahrens 
ermoglicht, Erfassungssystem der Art. die ein festes Gehause umfaBt. mit dern 
das absolute Bezugssystem verbunden ist. ein bewegliches Terminalorgan. mit 
dem ein Terminalsystem genanntes Bezugssystem (R.S.T) verbunden ist, eine 
Reihe von Betatigungsorganen zur Bewegung des Terminalorgans relativ zum 
festen Gehause. Mittel (18. 7c. 6a. 6b. 5a) zur Bestimmung der Position und der 
Orientierung des Terminals relativ zum festen Gehause,, die in der Lage sind. eine 
Matrix M^y zum Obergang vom Terminalsystem (R.S.T) zum absoluten 
Bezugssystem (X.Y.Z) zu speichern. die oben erwahnte vom Terminalorgan 
getragene Sensoreinheit. die dazu eingerichtet ist, eine strukturierte Welle, d.h. 
einen Strahl bekannter Form zum dreidimensionalen Objekt zu senden und das 
vom genannten Objekt zuruckgeworfene Echo aufzunehmen. und Mittel zur 
Speicherung der von der Sensoreinheit abgegebenen Informationen, die 
Rohinformationen genannt werden und die aufgenommenen Echos darstellen. 

Derartige Erfassungssysteme (gelegentlich auch mit dem Begriff: Digitalisierungs- 
system oder "C.M.M." - "Coordinates Measuring Machine' bezeichnet) sind 
bekannt. die insbesondere in Tomographen. Ultraschallgeraten. Scannern etc. 
angewendet werden. In der Mehrheit dieser Systeme enthalt die Sensoreinheit ein 
Beleuchtungssystem. das in der Lage ist. mindestens einen Lichtstrahl zum Objekt 
zu senden. und ein Videosystem. das in der Lage ist, das Objekt mit einer relativ 
zum Strahf des Beleuchtungssystems konstanten Parallaxe zu filmen. um 
Rohinformationen (p.q) in Abhangigkeit von den Spalten (p) und Zeilen (q) der 
Bilder der Punkte der Spur jedes Lichtstrahles auf dem Objekt ausztigeben. In den 
Patenten FR 76.06176. FR 79.28885. FR 81.24418. WO 87/01194. EP 0.163.076. 
EP 0.222.498 sind der oder die Strahlen des Beleuchtungssystems vom lamellaren 
Typ (insbesondere Laserebene) und das System digitalisiert den Schnitt jeder 
Laserebene mit dem Objekt. 
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2.1. Erfassungssystem gemaB einem der Patentanspruche 13 bis 20. in dem 

• die Reihe von BetStigungsorganen . aus einer kinematischen Kette von 
Motoren besteht. von denen einer mit dem GehSuse fest verbunden ist und ein 
anderer das Terminalorgan tragt. 

• die MIttel zur Bestimmung der Position und der Orientierung des Terminals 
relativ zum festen Gehause mit jedem Motor verbundene Sensoren fur die 
Winkelstellung umfassen, Mittel zum Zahlen der von den Sensoren abgegebenen 
Signale, ein Rechenmodul. dafur programmiert, die Matrix M^t aus den 
Informationen zu bllden. die die oben genannten Speichermittel und die genannten 
Zahlmittel abgeben. und einen Speicher zur Speicherung der genannten Matrix 
Mat. 
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Fig. 5a 
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Fig. 6 
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Fig. 7a 
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Fig. 8a 
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Fig. 9a 
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Zwischentransfertfunktion die folgende lineare Form hat: 



_ apk bQk + c 
' " gpA- + hqk + 1 
J ^ dp/c -^ eq/c + f 
Qpk + hqfr + 1 
w/ = 0 



V/ 



wobei die Zwischentransfertfunktion N fur die Gesamtheit dieser auf ihre 
entsprechenden Elementarzonen angewandten Elementarfunktionen aufgestellt 
wird. 



19. 



Erfassungssystem gemaa einem der Patentanspruche 13. 14. 15. 16. 17 oder 18. 
in dem die Sensoreinheit ein Beleuchtungssystem enthalt. das dazu in der Lage 
ist. mindestens einen lamellaren Strahl auf das Objekt zu senden, und ein 
Videosystem. das dazu in der Lage ist. das Objekt mit einer konstanten ParaUaxe 
relativ zu den Strahlen des Beleuchtungssystems zu filmen, urn Rohinf ormationen 
(p. q) in Abhangigkeit von den Spalten (p) und Zeilen (q) der Bilder der Punkte der 
Spur jedes Strahles auf dem Objekt oder dem Kallbrierobjekt zu liefern. 



20. Erfassungsystem gemafi Patentanspruch 19. dadurch gekennzeichnet, dad der 
Rechner mit einem Programm zur Berechnung der Zwischentransfertfunktion 



u = F (p. q) 



N < 



^ a/7f/(p)-g/(q) 
^ n =. 0 

n 

1 + ^ y/yf/(p)-gy(q) 



5] P'/f'(P)*g;(q) 
V = G (p. q) = 



1 + ^ Y/7f'(p)-gy(q) 



L w = 0 



programmiert ist, wobei die Funktionen f/. gy eine beschrankte Entwicklungsbasis 
darstellen. wobei die Koeffizienten a/y. P/y, y/y durch Anwendung dieser 
Gleichungen auf eine Anzahl von Reliefpunkten des* Kalibrierobjektes, die 
mindestens gleich 1 + ^HiniH die das Quadrupel (u. v. p, q) bekannt und 

gespeichert ist. und. durch Ldsung .des erhaltenen linearen Gleichungssystems 
bestimmt werden. 
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14. Erfassungssystem gemail Patentanspruch 13. dadurch gekennzeichnet, daR das 
Kalibrierobjekt eine Platte umfaRt, die mit einem Netz von MeBstaben versehen 
ist. 

15. Erfassungssystem gemaB Patentanspruch 13, dadurch gekennzeichnet. daR das 
Kalibrierobjekt einen einzigen MeGstab umfaBt. 

16. Erfassungssystem gemali eInem der Patentanspruche 13. 14 oder 15. in der Lage. 
eine Eichung gemSG Patentanspruch 9 vorzunehmen. dadurch gekennzeichnet. 
daft: 

• die Mittel zur Befestigung des Kalibrierobjektes dazu eingerlchtet sind. die 
Befestigung des genannten Kalibrierobjektes in einer vorher festgelegten . 
bekannten Position refativ zum Gehause sicherzusteMen. 

• die Speichermittel einen Speicherbereich fur die entsprechenden 
Positionsdaten des genannten Kalibrierobjektes umfassen und einen Speicher- 
bereich fur die Matrix Mac des Uberganges vom Sensorsystem zum absoluten 
Bezugssystem. 

• der Rechner in der Lage und dafur programmiert ist, die Matrix M^c 
bestimmen und die Matrix Mjc aus den Matrizen Mac und Mato zu berechnen, 

17. Erfassungssystem gemaG einem der Patentanspruche 13, 14. 15 oder 16. in der 
Lage. eine Eichung gemSG Patentanspruch 10 vorzunehmen. dadurch 
gekennzeichnet, daG: 

• das genannte System ein Bezugsobjekt enthalt. das mindestens einen 
charakteristischen Punkt aufweist und Mittel zur Befestigung des Bezugsobjektes 
am Gehause, 

• die Speichermittel einen Speicherbereich fur die Matrizen Mati, Mat/ 
umfassen. 

• der Rechner in der Lage und dafur programmiert ist, das Gleichungssystem 
nach M-pc aufzulosen. 

18. Erfassungssystem gemaG Patentanspruch 17. dadurch gekennzeichnet. daG der 
Rechner mit einem Programm zur Auflosung des Gleichungssystems nach Mjc 
programmiert ist, in dem die Zwischentransfertfunktion N durch Aufteilung des 
Kalibrierobjektes in n Elementarzonen und Berechnung einer elementaren 
Transfertfunktion Ne fur jede Elementarzone (e) berechnet wird. wobei jede 
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12.. Eichverfahren gemafi Patentanspruchen 1 bis 10. dadurch gekennzeichnet, dall 
die Berechnung der Zwischentransfertfunktion N und die Berechnung der Matrix 
Mjc des Uberganges vom Sensorsystem zum Terminalsystem jeweils durch 
Aufstellung eines abundanten Gleichungssystems und dessen .L6sung im Sinne 
der kleinslen Quadrate erfolgt. 

13. System zur Formerfassung. in der Lage. die Koordinaten (x, y. z). die die Form 
eines dreidimensionalen Objektes in einem absolut genannten Bezugssystem (X. 
Y. Z) reprasentieren. auszugeben. wobei das genannte Erfassungssystem ein 
festes Gehause umfafit. mit dem das absolute Bezugssystem verbunden ist. ein 
bewegliches Terminalorgan, mit dem ein Terminalsystem genanntes Bezugssystem 
(R. S. T) verbunden ist. eine.Reihe von Betatigungsorganen zur Bewegung des 
Terminalorgans relativ zum festen Gehause. Mittel (18, 7c, 6a. 6b. 5a) zur 
Bestimmung der Position und der Orientierung des Terminals relativ zum festen 
Gehause. die in der Lage sind. eine Matrix M^t zum Ubergang vom Terminal- 
system (R. S. T) zum absolulen Bezugssystem (X. Y. Z) zu spelchern. eine vom 
Terminalorgan getragene Sensoreinheit. die dazu eingerichtet ist, eine struktu- 
rierte Welle zum dreidimensionalen Objekt zu senden und das vom genannten 
Objekt zurtiGkgeiworfene Echo aufzunehmen, und Mittel zur Speicherung der von 
der Sensoreinheit abgegebenen Informationen. die Rohlnformationen genannt 
werden und die aufgenommenen Echos darstellen. wobei das genannte System 
dadurch gekennzeichnet ist. dali es Eichmittel zur Anwendung des Verfahrens 
gem^B einem der Patentanspruche 1 bis 12 enthalt. umfassend: 

- ein Kalibrierobjekt. das ein oder mehrere Reliefs bekannter Geometrie und 
Abmessungen aufweist. 

- Mittel zur Befestigung des Kalibrierobjektes am Gehause. 

Speichermittel. einen Speicherbereich fur die Informationen zur 
geometrischen Definition des Kalibrierobjektes und einen Speicherbereich fur die 
Matrix Mtc des Uberganges vom Sensorsystem zunri Terminalsystem enthaitend. 

- und einen Rechner. in der Lage und dafur programmiert. die Umsetzung der 
Informationen zur geometrischen Definition in Koordinaten auszufuhren, um die 
Zwischentransfertfunktion N zu berechnen. und die globale Transfertfunktion . L - 
nach dem Verfahren gemali einem der Patentanspruche 1 bis 12 durch 
Matrizenmultiplikation zu berechnen. 
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10. Eichverfahren gemaR einem der PatentansprOche 1 bis 8. dadurch 
gekennzeichnet; da(i die Matrix Mjc des Oberganges vom Sensorsystem (U, V. W) 
zum Terminalsystem (R. S, T) bestimmt wird, 

• indem mindestens ein charakteristischer Punkt eines Bezugsobjektes in / 
Positionen der Sensoreinheit erfaRt wird, um die die entsprechenden Echos 
darstellenden Rohinformationen (p^. qi,... p^^, qA,... P/, q/) zu erhalten. 

indem mittels der Zwischentransfertfunktion N die entsprechenden 
Koordinaten (ui, v^. Wi.... U;^. v^^, W;^.... u,, V/. W/) im Sensorsystem berechnet 
werden, 

• indem die fur jede der Erfassungspositionen von den Bestlmmungsmittein 
gelieferten Matrizen Mati.- ■ Mat^.- - M^t/ gespeichert werden, 



♦ indem das folgende Gleichungssystem gelost wird, um die Unbekannte Mjc 
zu berechnen: 



wo 



yo 

20 



Vo 

2^0 



= [Mat/c] • M 



TC 



1 < /C < / 



die unbekannten Koordinaten des charakteristischen Punktes des 



Kalibrierobjektes sind. die bei der Losung des Gleichungssystems durch 
Substitution eliminiert werden. 



11. Eichverfahren gemali Patentanspruch 10. dadurch gekennzeichnet, dafi die / 
Positionen der Sensoreinheit einerseits durch eine schrittwetse Drehung des 
Terminaiorgans um den Ursprung des Terminalsystems (R. S, T) und andererseits 
durch eine schrittweise Translationsbewegung parallel zu einer bekannten. mit 
dem genannten Terminalsystem (R, S, T) verbundenen Achse erhalten werden, so 
daR die Matrix Mjc aus der Position des Ursprunges des Terminalsystems im 
Sensorsystem (U. V. W) und der Orientierung des genannten Terminalsystems im 
Sensorsystem gewonnen wird, wobei die Losung des genannten Gleichungs- 
systems durch dessen Aufteilung in zwei unabhangige Untersysteme erfolgt, von 
denen das eine die Punkte verwendet, die durch die Drehung geliefert werden und 
die Position des genannten Ursprungs liefert, wShrend das andere die Punkte 
verwendet. die durch die Translationsbewegung geliefert werden und die 
Orientierung des Terminalsystems (R. S. T) liefern. 
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7. Eichverfahren gemSli Patentanspruch 4, dadurch gekennzeichnet. dali die 
Zwischentransfertfunktion N berechnet wird, indem das Kalibrierobjekt in n 
Elementarzonen unterteilt wird und indem fur jede Elementarzone (e) eine 
Elementartransfertfunktion Ng gemafi einem der Patentanspruche 5 oder 6 
berechnet wird. wobei die Zwischentransfertfunktion N fur die Gesamtheit dieser 
Elementarfunktionen aufgestellt wird, die auf ihre entsprechenden.Elementarzonen 
angewandt werden. 

8. Eichverfahren gemafi Patentanspruch 4, dadurch gekennzeichnet. daG die 
Zwischentransfertfunktion N berechnet wird, 

• indem vorab eine Linearisierungstabell e p'(p,q). q'(p,q) gespeichert wird, 
die die Verzerrungen des Erfassungssystems beschreibt, 

• indem vorab die Rohinformationen (p. q) mit Hilfe der genannten 
Linearisierungstabelle korrigiert werden. um korrigierte Informationen p'. q' zu 
erhalten. 

• indem die Transfertfunktion N in der linearen Form gemafi Patentanspruch 
4 berechnet wird: 

_ , , ap' + bq' c 
u = F (p. q) = ^ 



N < 



gp" + hq' + 1 . 

/ V dp' + eg' + f 
V = G (p. q) = ^ 

gp' + hq' + 1 

w = 0 



9. Eichverfahren gemafi einem der PatentansprOche 1 bis 8, dadurch gekennzeich- 
net. daOi die Matrix M-rc des Obergangs vom Seinsorsystem (U, .V. W) zum 
Terminalsystem bestimmt wird, 

- indem das Kalibrierobjekt in einer vorher f estgelegten. bekannten Position 
auf dem festen Gehause befestigt wird und die entsprechenden Daten gespeichert 
werden. 

• inderri aufgrund dieser Oaten eine Matrix Mac des Uberganges vom 
Sensorsystem (U. V, W) zum absoluten Bezugssystem (X. Y, Z) fur die 
Kah'brierposition bestimmt und gespeichert wird, 

• indem die von den Bestimmungsmittein in der Kalibrierposition gelieferte 
Matrix Mat gespeichert wird. die mit Mato bezeichnet wird. 

• und- indem die Matrix Mjc 3us den oben genannten Matrizen berechnet 
wird: Mtc = (Mato)-^-Mac. 
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5. Eichverfahren gemaG Patentanspruch 4. dadurch gekennzeichnet. dafi eine 
Zwischentransfertfunktion N der folgenden linearen Form berechnet wird: 

r- / X ap + bq + c 
u = F (p. q) = ^ 

gp + hq + 1 

V = G (p. q) = ^a^t_eiil 
gp + hq + 1 

w = 0 



N < 



wobei die Koefflzienten (a-h) bestimmt werden. indem diese Glelchungen auf 
mindestens vier Punkte der Reliefs des KaHbrierobjektes angewandt werden, fur 
die das Quadrupel (u. v, p, q) bekannt und gespeichert ist. und das erhaltene 
lineare Gleichungssystem gelost wird. 

Eichverfahren gemaft Patentanspruch 4. dadurch gekennzeichnet. dad eine nicht- 
lineare Zwischentransfertfunktion N der Form 



u = F (p. q) = 



N < 



V = G (p. q) 



^ a//f/(p)-gy(q) 
>•/ = 0 

n 

1 + ^ V>;f'(P)-9/(q) 
ii = 1 



^ P/yf/(p)-gy(q) 

=. 0 

n 

1 + ^ y/yf/(p)-g/(q) 



V w = 0 

berechnet wird, in der f/. gy eine beschrSnkte Entwicklungsbasis ist, die 
Koefflzienten a/y. P/y. y/; durch Anwendung dieser Gleichungen auf eine Anzahl von 
Reliefpunkten des KaHbrierobjektes. die mindestens gleich 1 + ^^(^'*'^) 

das Quadrupel (u, v, p, q) bekannt und gespeichert ist. und durch Losung des 
erhaltenen linearen Gleichungssystems bestimmt werden. 



N 



u = F (p. q,.,) 
V = G (p. q...) 
w = H (p, q..,) 



zu berechnen, die die Koordinaten (u, v. w) im Sensorsystem (U, V. W) in 
Abhangigkelt von den Rohinformationen (p. q) liefert, 

• die Position des Sensorsystems (U, V. W) im Terminalsystem (R. S, T) zu 
bestimmen und eine Matrix Mjc ^ur den Ubergang vom Sensorsystem zum 
Terminalsystem zu speichern. 

■ die Zwischentransfertfunktion N mit einerseits der Obergangsmatrix Mjc 
und andererseits der Obergangsmatrix M^t zu multiplizieren und die globale 
Transfertfunktion L = Maj-Mtc'N zu erhalten. 

2. Eichverfahren gemSS Patentanspruch 1, dadurch gekennzeichnet. dafi ein 
Kalibrierobjekt verwendet wird, das eine Platte umfaflt, die auf einer Flache ein 
Netz aus MeBstaben tragt. und daB als definierende Informationen Koordinaten 
(U;c. v^) gespeichert werden. die mit jedem MeBstab des Kalibrierobjektes In einem 
Bezugssystem (U, V) verbunden sind. das in der Ebene der Flache des das Netz 
aus Mefistaben triagenden Kalibrierobjektes liegt. 

3. Eichverfahren gemafi Patentanspruch 1, dadurch gekennzeichnet. daB ein. 
virtuelles Kalibrierobjekt verwendet wird. das aus eiriem einzigen Melistab 

• gebrldet wird. indem die Sensoreinheit in mehreren bekannten Eichpositionen 
angeordnet wird, indem als definierende Information Koordinaten (u^. V;^) 
gespeichert werden, die in den verschiedenen Eichpositionen in einem mit der 
Sensoreinheit verbundenen Bezugssystem (U, V) verbunden sind. indem die die 
Echos des einzigen MefLstabes. die von der Sensoreinheit in den verschiedenen 
Eichpositionen erfaftt werden. darstellenden Rohinformationen (p. q...) 
gespeichert werden und indem diese Rohinformationen zusammengesetzt werden. 
um ein virtuelles Netz zu bilden. das das virtuelle Kalibrierobjekt darstellt. 

4. Verfahren gemaft einem der Patentanspruche 1. 2 oder 3 fur die Eichung eines 
Erfassungssystems, in dem .die Sensoreinheit ein Beleuchtungssystem enthalt. 
das in der Lage ist. mihdestens einen lamellaren Lichtstrahl zum Objekt zu. 
senden, und ein Videpsystem. das in der Lage ist, das Objekt mit einer relativ zum 
Strahl des Beleuchtungssystems konstanten Parallaxe zu filmen. um Rohinforma- 
tionen (p. q) in Abhangigkeit von den Spalten (p) und Zeilen (q) der Bilder der 
Punkte der Spur jedes Lichtstrahles auf dem Objekt oder dem Kalibrierobjekt zu 
liefern. 
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1 

Patentanspruche 

Verfahren zur Eichung eines Systems zur Formerfassung, das in der Lage ist, die 
Koordinaten (x. y. z), die die Form eines dreidimensionalen Objektes in einem 
absolut genannten Bezugssystem (X. Y, Z) repras^ntieren. auszugeben. wobei das 
genannte Erfassungssystem ein festes GehSuse umfaBt. mit dem das absolute 
Bezugssystem verbunden ist, ein bewegliches Terminalorgan. mit dem ein 
Terminalsystem genanntes Bezugssystem (R, S. T) verbunden ist. eine Reihe von 
Betatigungsorganen zur Bewegung des Terminalorgans relativ zum festen 
Gehause. Mittel (18, 7c. 6a. 6b. 5a) zur Bestimmung der Position und der 
Orientierung des Terminals relativ zum festen Gehause. die in der Lage sind, eine 
Matrix M^t zum Ubergang vom Terminalsystem (R, S, T) zum absoluten 
Bezugssystem (X. Y. Z) zu speichern, eine vom Terminalorgan getragene 
Sensoreinheit, die dazu eingerichtet ist. einen Strahl bekannter Form zum 
dreidimensionalen Objekt zu senden und das vom genannten Objekt 
zuruckgeworfene Echo aufzunehmen, und Mittel zur Speicherung der von der 
Sensoreinheit abgegebenen Informationen . die Rohi nformationen genannt w/erden 
und die aufgenommenen Echos darstellen. wobei das genannte Eich verfahren es 
ermoglicht. die globale Obertragungsfunktion L zwischen jeglichem 
zuruckgeworfenen Echo und den entsprechenden absoluten Koordinaten (x. y, z) 
im absoluten Bezugssystem zu bestimmen. die vom Erfassungssystem 
ausgegeben werden sollen, und dadurch gekennzeichnet, dafl es darin besteht: 

• vorab Informationen geometrischer Art Ober ein Kalibrierobjekt zu 
speichern. das ein oder mehrere Reliefs bekannter Geometrie und Abmessungen 
aufweist, 

• die Form des genannten Kalibrierobjektes mittels der Sensoreinheit zu 
erfassen, die in mindestens einer bestimmten Position relativ zum genannten 
Kalibrierobjekt. Eichposition(en) genannt. angeordnet ist. um die entsprechenden 
Rohinformationen (p, q...). die die von der genannten Sensoreinheit erfaRten 
Echos darstellen, zu speichern, 

• fur jede genannte Eichposition die das Kalibrierobjekt definierenden 
Informationen in Form von Koordinaten (u, v. w) in ein mit dem Sensor 
verbundenes und Sensorsystem (U. V, W) genanntes Bezugssystem umzusetzen. 

• aus den Ergebnissen der genannten Erfassung und den das Kalibrierobjekt 
charakterisierenden Koordinaten (u. v. w) im Sensorsystem eine Zwischentransfer- 
funktion 
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Positionsinformationen berechnet, die das Interface. 7c Mefert. und aus die 
kinematische Kelle definierenden Informattonen aus dem Speicherbereich 6a. 
Diese in der Robotertechnik an sich bekannte Berechnung ist in der Fig. 12 
dargestellt. Wenn der (n + 1)-te Motor am n-ten Motor angebracht ist. wird der 
Obergang vom Bezugssystem n + 1 (das mit dem (n+1)-ten Motor verbunden sei) 
2um Bezugssystem n durch die Matrix 

= [Bn n+l][MoT n + l] 

ausgedruckt. 

B.n.n + i ist eine konstante Matrix der Konstruktion des Roboters. die aus den die 
kinematische Kette definierenden Informationen des Speicherbereichs 6a 
bestimmt wird . 

M 

OTn+1 ist eine variable Matrix, die von der Position des (n + 1)-ten Motors relativ 
zu einer Anfangsposition seines Sensors 18 abhangt und. durch die 
Positionsinformationen aus dem Interface 7c bestimmt v^^ird. 

Wie in Fig. 12 dargestellt, ergibt sich im Fall von sechs Motoren: 

Mat = Mo.i'Mi 2-M2.3-M3 4-M4 s'Ms 6 
wobei die Matrix . Mq.i die Matrix des Ubergangs vom ersten Motor 8 zum 
Bezugssystem des Gehauses (X, Y. 2) ist. wahrend die Matrix M5 g die Matrix des 
Ubergangs vom Terminalsystem (R, S. T) zum Motor 5 ist. 
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In einer vorgezogenen Ausf uhrungsform werden die / Positlonen der Sensoreinheit 
einerseits durch eine schrittwelse Drehung des Terminalorgans urn den Ursprung 
des Terminalsystems (R. S. T) und andererseits durch eine schrlttweise 
Translationsbewegung parallel zu einer bekannten, mit dem genannten 
Terminalsystem (R, S, T) verbundenen Achse erhalten. so daft die Matrix Mjc aus 
der Position des Ursprunges des Terminalsystems im Sensorsystem (U. V. W) und 
der Orientierung des genannten Terminalsystems im Sensorsystem gewonnen 
wird, wobei die Losung des genannten Gleichungssystems durch dessen 
Aufteilung in zwei unabhangige Untersysteme erfolgt, von denen das eine die 
Punkte verwendet. die durch die Drehung geliefert werden und die Position des 
genannten Ursprungs liefert. wShrend das andere die Punkte verwendet. die durch 
die Translationsbewegung geliefert werden und die Orientierung des 
Terminalsystems (R. S. T) liefern. 

Wahrend der Rotation beschreiben die Meftstabe im Sensorsystem (U, V, W) 
Kreisbogen um den Ursprung d.es Terminalsystems • (Koordinaten Uq. Vq. Wq), der 
damit durch Bestimmung des Mittelpunktes dieser Kreisbogen im Sinne der 
klelnsten Quadrate berechnet wird. 

Wahrend der Translationsbewegung beschreiben die Mefistabe im Sensorsystem 
(U. V, W) zur Bewegungsrichtung des Terminalsystems (R. S. T) parallele 
Geradenabschnitte, dessen Orientierung damit im Sinne der kleinsten Quadrate, 
im Sensorsystem in Form der Richtungskosinus (R^j. R^. R^: S^. S^. S^; T^, T^. Tv,) 
der Vektoren R, S, T berechnet wird. 

Die Matrix Myc hat dann die folgende homogene Form: 



10 0 0 




Vq Ry Sy Ty 

Wq Rw TyV 



Die Rechenfolge zur Berechnung dieser Matrix Mjc »st in Fig. 11 dargestellt. 

Dariiber hinaus wird die Matrix M^j des Uberganges vom Terminalsystem (R. S. T) 
zum absotuten Bezugssystem (X, Y. 2) durch das Modul 5a des Rechners aus 
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die korrigierten Informationen p*. q' zu erhalten. Das Gleichungssystem wird dann 
wie im linearen Fall aufgestellt und geldst. 

Fig. 9b stellt die lineare Zwischentransfertfunktion ohne Anwendung der Korrektur 
dar und Fig: 9c stellt diese Funktion korrigiert dar (in der Form u = konst.. 
V = konst. in der (p*. q*)-Ebene). 

Das Eichverfahren besteht dann darin. die Matrix (Mjc) des Uberganges vom 
Sensorsystem zum Terminalsystem zu faestimmen. um ihr Produkt mit.der wie oben 
angegeben berechneten Zwischentransfertfunktion N zu bilden. 

Diese Bestimmung von Mjc erfolgt durch den Schritt der Bestimmung eines 
Bezugspunktes. der in Fig. 10 dargestellt ist. mit den entsprechenden. auf dem 
Kontrollmonitor 22 erscheinenden Bildern; dieser Schritt der Bestimmung eines 
Bezugspunktes besteht darin, 

- mindestens einen charakteristischen Punkt eines Bezugsobjektes in / 
Positionen der Sensoreinheit zu erfassen, um die die entsprechenden Echos 
darstellenden Rohinformationen (p^. qi. .. p^, q/f, .. P/. q/) zu erhalten. 

• mittels der Zwischentransfertfunktion (N) die entsprechenden Koordinaten 
(Ui. v,. w^,... u;^. V;,, w^,... u/, V,. w;) im Sensorsystem zu berechnen, 

• die fur jede der Erfassungspositionen von den Bestimmungsmittein 
gelieferten Matrizen (Mati. .-- Mat*.- - Mat/) speichern, 

• das folgende Gleichungssystem zu losen. um die Unbekannte My^ zu 
berechnen: 

^ < k < / 



wo 



yo 
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= [Matu] • M 



TC 



die unbekannten Koordinaten des charakteristischen Punktes des 



Kalibrierobjektes sind. die bei der Losung des . Gleichungssystems durch 
Substitution eliminiert werden. 

Wie bereits angegeben. kann eine redundante Berechnung erhalten werden. indem 
- Im Fall klelner MeSstSbe 9 MelistSbe des Kalibrierobjektes ats 
charakteristische Bezugspunkte genommen werden. 

im. Fall dicker MeRstabe 3 Mittelpunkte von MeBstaben als 
charakteristische Bezugspunkte genommen werden. 



# 
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Fig. 7b stellt die so definierte Zwischentransfertfunktion dar, die nichtgeradlinlgen 
Kurven u = konst.. v = konst. In der (p, q)-Ebene entspricht. die In der Lage sind. 
sich dem Netz der MeBstabe trotz der Nichtlinearitat des Systems am genauesten 
anzuschmiegen. 

Fig. 8a stellt eine andere Rechenfolge dar. in der die Zwischentransfertfunktion N 
berechnet wird. indem das Kalibrierobjekt in n Eiementarzonen unterteilt und fur 
jede Elementarzone (e) eine Elementartransfertfunktion Ng berechnet wird, wobei 
die Zwischentransfertfunktion N durch die Gesamtheit dieser Elementarfunktionen 
dargestellt wird, die auf ihre entsprechenden Eiementarzonen angewandt werden. 
Die Fplge ist ahnlich der der Berechnung d^r vordefinierten Eichung. jed.och mit 
einer Rechenschleife fur jede Zone. Dieses Verfahren ist bei geringen 
Nichtlinearltaten anwendbar, die es erlauben, eine geringe Zahl praktisch linearer 
Zonen zu definieren (beispielsweise 16 Zonen). 

Fig. 8b stellt das Zus ammens etzen der Zwischentransfertfunktionen fur die 
verschiedenen Zonen in der Form u = konst.. v = konst. in der (p. q)-Ebene dar. 

Fig. 9a stellt eine andere Rechenfolge dar. in der die Zwischentransfertfunktion N 
berechnet wird; 

■ indem vorab eine Linearisierungstabelle p'(p,q), q'{p,q) gespeichert wird. 
die die Verzerrungen des Erfassungssystems beschreibt. 

• indem vorab die Rohinformationen (p, q) mit Hllfe der genannten 
Linearisierungstabelle korrigiert werden, um korrigierte Informationen p', q' zu 
erhalten. 

• indem die Transfertfunktion N in der linearen Form gemali Patentanspruch 
4 berechnet wird: 

r- / X ap' + bq' + c 
u = F (p. q) = ^ 

gp* + hq' + 1 

^ \ i V dp' -4- eg' + f 
V = G (p. q) = ^ 

gp' + hq* + 1 

. < w = 0 

Die Linearisierungstabelle wird durch direkte Messung der Verzerrungen des 
Systems aufgestellt - optische. elektronische Verzerrungen - und enthSIt 
Korrekturkoefflzlenten, die auf die Rohinformationen p. q anzuwenden sind, um 
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^ avfi(p) gy(q) 



u = F(.p. q) = -^ 



N < 



V - G (p. q) 



1 + ^ Y»/fi(p)-g/(q) 

ij = 1 



^ P'/f'(p)-g/(q) - 

'< = 0 

n 

1 + ^ Yvf'(P)-gy(q) 

w = 0 

gewahlt. in der f/, gy eine beschrankte Entwicklungsbasis ist, die Koeffizienten a/y. 
p,y. durch Anwendung dieser Gleichungen auf eine Anzahl von Reliefpunkten 
des Kalibrierobjektes. die mindestens gleich 1 + 

Quad ru pel (u. v, p, q) bekannt und gespeichert ist, und durch L 6 sung des 
erhaltenen linearen Gleichungssy stems bestimmt werden. 

Die Nichtlinearitaten der Koeffizienten' fiihren zu geringen Variationen (einige 
Prozent) der Zwischentransfertf uhktion und diese Koeffizienten konnen also in 
Form einer beschrankten Entwicklung ausgedruckt werden. 

Die Entwicklungsbasen f,. gy konnen die Form von Polynomen haben g (q^) = qj^ 
Sie kOnnen ebenfalls eponentiell sein: „ 

Durch EInsetzen dieser Entwicklungen in die Funktionen F, G und durch Zerlegung 
in Faktbren bezuglich der Koeffizienten ot/y, p/y. y/y ergibt sich ein System linearer 
Gleichungen in a/y. P/y. y/y mit einer Anzahl von Unbekannten, die von der Ordnung 
n der Entwicklung abhSngig ist. 



Dieses System kann ebenfalls nach .den kleinsten. Quadraten aufgelost werden, 
indem eine abundante Anzahl an Mefistaben gewahlt wird. 
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Fig. 5b ist eine Darstellung der Zwischentransf ertfunktion in der Form u = konst. 
und V = konst. in der (p, q)-Ebene. 

Im Fall dicker MeBstSbe erfolgt die Ldsung nach den Mittelpunkten der berech- 
neten Kreise, die den Bogen der Helligkeitskreise am genauesten enlsprechen, im 
Sinne der kleinsten Quadrate. Die Anzahl der Mefislabe wird dann grofier als 4 
gewahit (4 bis 6), um fur ausreichende Redundanz zu sorgen. um die KohSrenz 
der Losung Oberprufen zu konnen. Die Quantisierungsfehier bei den p/^ und q/^ der 
Mittelpunkte der MelistSbe werden durch die Auflosung nach den kleinsten 
Quadraten der Kreise minimalisiert, die den aus 20 bis 30 Punkten bestehenden 
leuchtenden Bogen am genauesten entsprechen. Diese Methode der dicken 
Mefistabei fuhrt zu praziseren Ergebnissen, als die Methode der vielen kleinen 
Me^stabe. 

Fig. 5c stent die Zwischentransf ertfunktion bei dicken Meftstaben in der Form 
u = konst. und v = konst. in der (p, q)-Ebene dar. 

Die Helllgkeitsstellen 5e sind die Schnittpunkte des Lasers mit den dicken 
Meftstaben. 

Die Kreise 5f ergeben dieses Netz von Me(3staben, das durch die Berechnung 
wiederhergestellt wird. 

Die Kreismittelpunkte 5g sind dann Koordinaten p;^. q^^ in reellen Zahien in der 
(p. q)-Ebene. 

Die Fig. 7a, 8a und 9a stellen Rechenfolgen im Fall von drei anderen Formen der 
Zwischentransfertfunktion dar: Nichtlinear, auf Elementarzonen definiert. durch 
Tabelle korrigiert; die Fig. 7b. 8b, 9b und 9c stellen diese Zwischentransfert- 
funktionen dar. 

Im Fall der Fig. 7a eines nichtlinearen Systems (optische Aberration der Kamera. 
Videoverzerrung etc.) wird angenommen, dad die vorangehende lineare Form lokal 
gultig ist und daB die Koeffizienten a - h Furiktionen des Punktes (p, q) sind; die 
Zwischentransfertfunktion wird dann in der Form 
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MefistSben). in Koordinaten (u. v. w) jedes virtuellen MeBstabes im Sensorsystem 
(U. V, W) umgesetzt. 

Im beschriebenen Fall der linearen Eichung wird die Form der 
Zwischentransfertfunktion 

u = F (p. q) = 



N < 



/- / X dp eg f 
V = G (p. q) = ^ 



gp + hq + 1 
dp eg f 
gp + hq + 1 



w = 0 



gewahlt. wobei die Koeffizienten (a-h) bestimmt werden. indem diese Gleichungen 
auf mindestens vier Punkte der Reliefs des Kalibrierobjektes angewandt werden. 
fur die das Quadrupel (u, v. p. q) bekannt und gespeichert ist. und das erhaltene 
lineare Gleichungssystem gelbst wird, das auf /. Meftstabe (laufender Index k) 
angewandt wird und das folgende lineare Gleichungssystem liefert: 



1 < /c < / 



aP/c bq^f + C + 0 + 0 + 0 - gu/^p;, - hu^^q^, = U;, 



.0 + 0 + 0 + dp;, + eq;, + f - gV^^P;, - hV;,q;, = V;, 

das allgemein In der Matrixform 

MX = Y 

geschrieben werden kann. wobei X der unbekannte Vektor a, b, c, d. e. f. g, h ist. 
der die Zwischentransfertfunktion N definiert, und wobei M eine Tabelle der 
Dimension 8 Zeilen ma.l 21 Spalten ist. 

Die Losung nach den kleinslen Quadraten Ist gegeben durch 

X = (TM-M)-i • TM-Y 

Der Logikplan der Fig. 6 stellt die Aufstellung des Glelchungssystems und seine 
Losung dar. 

Im Fall kleiner Melist^be erfolgt die Losung nach dem Schwerpunkt der aus 1. 2 
Oder 3 Pixein bestehenden Helligkeitsstelle. Die Anzahl der Meftstabe wird dann 
grbfter als 4 gewahit, insbesondere 9 < / < 25. urn fur Redundanz zu sorgen und 
die Minimalisierung der Quantisierungsfehler von p^^ und q^^ zu ermoglichen, die 
mit der Aufldsung der Kamera und der Probenahme der Erfassung verbunden sind. 
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Dieser letztgenannte Schritt. der an sich im Bereich der Robotertechnik bekannt 
ist. besteht darln. die Unvollkommenheiten der mechanischen Organe des 
Robolers wahrend der Bewegungen mit Hilfe geeigneter mefttechnischer Meftin- 
strumente (Neigungsmesser, Langenmafivergleicher, Fernrohre, Theodolithen etc.) 
zu ermittein, um die Korrekturkoeffizienten zur Kompensation dieser 
Unvollkommenheiten zu bestimmen. 

Fig. 4 zeigt das System wahrend der Eichung in der sogenannten Eichposition. 
wahrend die Fig. 5a und 6 den Programmablauf und den Algorithmus der 
Berechnung im Fall der linearen Eichung darstellen. Der zur Platte 4a parallele 
lamellare Lichtstrahl FL fallt auf die Mefistabe 4b und die Kamera erfaUt die 
genannten Meftstabe und gibt Rohinformationen (p, q) (Zeiien und Spalten der 
entsprechenden Echos) aus, von denen angenommen wird. daft sie auf einem 
Kamerakontrollmonitor 22 dargestellt werden. Diese Rohinformationen werden im 
Speicherbereich 6d gespeichert. 

Da das Sensorsystem (U. V. W) in dieser Eichposition eine bekannte Stellung 
relativ zum Kalibrierobjekt hat. werden die das Kalibrierobjekt definierenden 
Informationen. die sich im Speicherbereich 6c befinden (Rasterschritt des Netzes 
zwischen den Mefistaben), in Koordinaten (u. v. w) jedes MeRstabes im 
Sensorsystem (U, V, W) umgesetzt. In der Praxis kann ein Sensorsystem gewahit 
werden. das durch den zentralen Mefistab verlauft. so daft zwei seiner Achsen zu 
den Reihen der Meftstabe parallel verlaufen und die andere Achse senkrecht 
dazu. Diese Umsetzung wird durch den Rechner 5 ausgefuhrt. der fur diesen 
Zweck programmiert wird. 

Im Fall des virtuetlen Kaiibrierobjektes fallt der lamellare Strahl FL auf den 
einzigen Meftstab 4f und die Kamera erfaftt den genannten Meftstab und gibt die 
Rohinformationen (p. q) (Zellen und Spalten des entsprechenden Echos) aus, von 
denen angenommen wird, daft sie auf einem Kamerakontrollmonitor dargestellt 
werden. Diese Rohinformationen werden in verschiedenen Stellungen der 
Sensorelnhelt relativ zum einzigen Meftstab erfaftt. wie in Fig. 1b schematisch 
dargestellt. und Im Speicherbereich 6d gespeichert. Da das Sensorsystem 
(U, V, W) bekannte Eichpositlonen relativ zum einzigen Meftstab einnimmt. werden 
die das virtuelle Kalibrierobjekt definierenden Informationen. die sich im Speicher- 
bereich 6c befinden (Rasterschritt des virtuellen Netzes zwischen virtuellen 
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• durch Einschaitung von Eichmittein 19 eine Zwischentransfertfunktion N 
aufzustellen und in einem Speicher 5c des Rechners zu speichern. die einer im 
genannten Rechner enthaltenen Programmoperation zugehort. 

• durch Einschaitung von MItteIn zur Bestimmung eines Bezugspunktes 20 
eine Matrix Mxc des Uberganges vom Sensorsystem (U, V. W) zum 
Terminalsystem (R. S. T) aufzustellen und in eInem Speicher 5d. des Rechners zu 
speichern. 

• gegebenenfalls durch Mittel zur mechanischen Charaklerisierung 21 eine 
Matrix COR zur Korrektur der mechanischen Fehler aufzustellen und In einem 
Speicher 5e des Rechners zu speichern. 

Die Messung eines Objektes. d h. die Erfassung der Koordinaten verschiedener 
Punkte seiner Oberflache. erfolgt nach dem folgenden Verfahrensablauf : 

• Programmierung einer Bahn des Roboters durch das Steuermodul 5b auf 
die Beleuchtung der Oberflache des zu erfassenden Objektes, 

• Ausfuhrung der entsprechenden Bewegungen durch die Motoren 8-13. 

• Speicherung der aufgenommenen Rohinformationen (p. q) im Speicher 6d 
bei jeder Stellung auf der Bahn. 

• Speicherung der durch die Mittel . zur Bestimmung der Position und der 
Orientierung des Terminals relativ zum festen Gehause aufgestellten Matrix Mat 
im Speicherbereich 6b. 

■ Anwendung der Zwischentransfertfunktion N auf die Rohinformationen 
(p. q). um die Koordinaten (u. v. w) des entsprechenden Punktes des Objektes im 
Sensorsystem (U, V, W) zu erhalten. 

• Anwendung der Ubergangsmatrix Mjc auf die.se Koordinaten (u. v. w). um 
die im Terminalsystem (R. S. T) entsprechenden Koordinaten (r. s, t) zu. erhalten. 

• Anwendung der Obergangsmatrix Mat auf diese Koordinaten (r. s. t). um. 
die im absoluten Bezugssystem (X. Y. Z) entsprechenden Koordinaten (x. y, z) zu 
erhalten; 

• gegebenenfalls Korrektur di'eser Koordinaten (x. y, z) durch Anwendung 
der Korrekturmatrix COR" 

Die folgende Beschreibung erl^utert das Eichverfahren durch das beschriebene 
System. Verfahren. das in drei Schritte unterteilt werden kann: Eichung. 
Bestimmung des Bezugspunktes. Charakterisierung. 
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genannt) besteht der erste Schritt der Eichung darin. Im Sinne der kleinsten 
Quadrate die Kreise bekannten Durchmessers zu suchen. die den von der Kamera 
digitalisierten Kreisbbgen am genauesten entsprechen. Die charakteristlschen 
Punkte des Kalibrierobjektes sind dann die Mittelpunkte der wiederhergestellten 
Kreise. 

Es ist auch. wie In Fig. 1b dargestelll. moglich, ein virtuelles Kalibrierobjekt aus 
einem einzigen Meflstab 4f zu bilden. Die Folge von Schemata der Fig. lb stellt 
verschiedene Positionen der Sensoreinheit relativ zum Mefistab fur den Fall dar, 
in dem die Laserebene zu einer der Bewegungsachsen der kinematischen Kette 
parallel ist. Die Aufzeichnung und Uberlagerung der verschiedenen Bilder. die in 
den verschiedenen bekannten Positionen des Sensors (Eichpositionen genannt) 
aufgenommen wurden. eriaubt die Bildung eines virtuellen Netzes. das das 
virtuelle Kalibrierobjekt darstellt, und die Ruckfuhrung auf die vorangehenden 
Falle eines materiellen Kalibrierobjektes. 

Das Kalibrierobjekt 4 ist mit Befestigungsmltteln. wie etwa einem Sockel des 
Kalibrierobjektes 4c, der an das Gehause 1 geschraubt ist. am genannten 
Gehause in einer derartigen Position befestigt. daft der lamellare Lichtstrahl der 
Sensoreinheit 3 parallel zur Ebene der Platte 4a des Kalibrierobjektes positioniert 
werden kann, so daf3> er auf dessen Meftstabe 4b fallt. Fur den Eichungsschritt, 
der der erste Schritt des Eichverfahrens ist, ist ein Sensorsystem (U, V, W) 
genanntes Bezugssystem mit dem lamellaren Lichtstrahl verbunden. um in dieser 
Eichstellung uber eine vorbestimmte Position relativ zum Kalibrierobjekt zu 
verfugen. 

Im betrachteten Beispiel ist das Kalibrierobjekt am Gehause in einer festen 
Stellung befestigt, die jedoch aufgrund des Schrittes der Bestimmung des 
Bezugspunktes, der in der weiter unten dargestellten Weise durchgefuhrt v/ird, 
nicht prSzise bekannt zu sein braucht. Es sei bemerkt. daQ dieser Schritt der 
Bestimmung eines Bezugspunktes in einer anderen Form der DurchfQhrung des 
Eichverfahrens um den Preis einer prazisen und bekannten Befestigung des 
Kalibrierobjektes am Gehause unterdruckt werden kann, wie weiter unten gezeigt 
wird. 

Fig. 3 ist ein Fluftdlagramm. das den Ablauf einer Messung nach Eichung des 
Systems zeigt. Das Eichverfahren eriaubt es. 
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Das Interface enthalt unter anderem Mittel 7c zum Zahlen der Signale. die aus den 
Sensoren 18 stammen, die an den Rechner Informationen abgeben, die die 
Position der Motoren darstellen. Die Speichermittel 6 umfassen einen Speicher- 
bereich 6a. in dem Daten uber den mechanischeh Aufbau des Roboters 
gespeichert sind (Lange der Arme, Winkelstellung der Motorachsen, Endsteflung 
etc.). Der Rechner 5 enthalt ein Rechenmodul 5a. das dafur programmiert ist, zu 
jedem Zeitpunkt aus den Informationen, die aus den Zahlmitteth 7c stammen, und 
den Informationen. die im Speicherbereich 6a gespeichert sind. eine Matrix Maj 

des Uberganges vom Terminalsystem (R, S. T) zum absoluten Bezugssystem zu 
erzeugen. Dieses Verfahren der Robotertechnik und die entsprechenden Matrix- 
rechnungen sind an sich bekannt und werden nicht waiter ausgefuhrt. Diese. Matrix 
wird in einem anderen Speicherbereich 6b der Speichermittel gespeichert. 

Die Sensoren fur die Winkelstellung 18. die Zahlmittel 7c. die Speicherbereiche 
6a und 6b und das Rechenmodul 5a werden in ublicher Weise mit dem 
allgemeinen Ausdruck: Mittel zur Bestimmung der Position und der Orientierung 
des Terminals relativ zum festen Gehause bezeichnet, deren Zweck darin besteht. 
die vorgenannte Matrix Mat erzeugen und zu speichern. 

Das Kalibrierobjekt 4 waist Reliefs mit bekannter Geometrie und Abrriessungen 
auf. die vorab in einem Speicherbereich 6c der Speichermittel gespeichert 
werden. Den beabsichtigten Anwendungen gemafi ist es moglich. mehrere 
Netzarten des Kalibrierobjektes vorzusehen. 

Im Beispiel der Fig. 1 ist das Kalibrierobjekt eine Platte 4a. die auf einer Flache 
ein Netz 4b von MefistSben tragt. die jeweils aus einem zylindrischen Zapfen 
derart geringen Durchmessers besteht.. dafi das Auftreffen des Lasers eine 
■ Helligkeitsstelle hervorruft. der maximal 1. 2 oder 3 Pixein der . Kamera 
entsprechen. In diesem Fall (Fall* kleiner Meflstabe genahnt) kann die Anzahl ah 
Mellstaben 9 bis 25 betragen. wobei die zentralen Meflstabe (zwischen 3 und 9) 
als charakteristische Bezugspunkte dienen. 

Im Beispiel der Fig. 1a ist das Kalibrierobjekt eine Platte 4d, die auf einer Flache 
ein Netz 4e von 4 bis. 5 MeHstSben trdgt. die jeweils aus einem zylindrischen 
Zapfen relativ groGen Durchmessers bestehen. derart. daQ das Auftreffen des 
Lasers eine Helligkeitsstelle hervorruft.. der einem Kreisbogen aus mindestens 20 
bis 30 Pixein der Kamera entspricht. In diesem Fall (Fall dicker Mefistdbe 
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2a des Roboters trSgt, mit dem ein Bezugssystem verbunden ist, das 
Terminalsystem (R, S. T) genannt wird und dessen Achse R mit der Achse dieses 
Motors zusammenfallt. c 

Das Sensorsystem 3 umfaGt ein Beleuchtungssystem 14 und eine 
Videovorrichtung 15. Das Beleuchtungssystem 14 besteht im Beispiel aus einem 
Helium-Neon-Rohrenlaser niedriger Leistung 14a. der mit einer zylindrischen Optik 
14b und einem Umlenkspiegel 14c verbunden ist. urn einen lamellaren Strahl FL 
auszusenden. Das Beleuchtungssystem 14 ist mit einem Futter mit Bajonett- 
kupplung 16 am Terminalorgan angebracht und mit Einstellmittein 17 versehen. 
die die Justierung der Stellung des lamellaren Lichtstrahles ermbglichen. Im 
Beispiel ist die Stellung dieses Strahles derart geregelt. daft dieser mit der Ebene 
RT des Terminalsystems (R. S. T) zusammenfallt. 

Die Videovorrichtung 15 umfafit eine CCD-Videokamera 15a, deren Gehause durch 
ein Scharnier 15b am Beleuchtungssystem 14 derart angelenkt ist. dafi die 
optrsche Aufnahmeachse AO eine konstante Parallaxe PAR relativ zum Lichtstrahl 
FL aufweist und die Kamera ein Blickfeld hat. das ihr ermoglicht, die Spur des 
Lasers auf dem beleuchteten Objekt zu filmen. Die Kamera 15a ist mit einem 
Objektiv 15c ausgestattet, das mit einem Interferenzfilter versehen ist, das auf die 
Wellenlange des Lichtstrahles abgestimmt ist. 

Die Kamera 15 gibt ein Videdsignal an das elektronische Interface 7 ab. Dieses ist 
mit einer Erfassungskarte 7a versehen. die aus. dem Videosignal Rohi nformationen 
(p. q) erzeugt und in einem Speicherbereich 6d speichert, die die durch die 
Kamera aufgenommenen Echos darstellen, d.h. das Bild der Spur des Licht- 
strahles FL auf dem untersuchten Objekt. Diese Karte ist an sich bekannt und 
kann von der im Patent FR 2.519.138 beschriebenen Art sein; sie gibt an den 
Rechner 5 Informationen (p, q) in Abhangigkeit von den Spalten (p) und Zeilen (q) 
der Bilder der Punkte der Spur aus. 

Der Rechner 5 enthSIt ein Modul 5b zur Steuerung des Weges. das uber einen 
Leistungsverstarker 7b des Interface 7 die Drehungen der Motoren 8-13 des 
Roboters steuert und damit die Position und die Orientierung des Terminalorgans 
2a relativ zum GehSuse 1! 




- die Fig. 8a und 8b ahnllche Darstellungen im Fall einer Zwlschentrans- 
fertfunktion. die auf Elementarzonen definiert tst. 

- die Fig. 9a. 9c ahnliche Darstellungen im Fall einer Zwischentransfert- 
funktion, die durch eine Linearisierungstabelle korrigiert wird. wobei die Fig. 9b 
das unkorrigierte Echo darstellt, 

- Fig. 10 eine perspektivische Teilansicht des Systems wShrend der 
Eichung (Schritt der Bestimmung des Bezugspunktes) mit Darstellung der Echos 
wahrend des Schrittes. 

- Fig. 11 einen Logikplan, der das Programm zur Auflosung des 
Gleichungssystems nach Mjc darstellt, 

- Fig. 12 ein Schema, das das Modeling der kinematischen Kette des* 
Roboters darstellt, das durch die Matrix Mat des Uberganges vom Terminalsystem 
zum absoluten Bezugssystem bieschrieben wird. 

Das in den Fig. 1 und 2 beispielhaft dargestellte Formerfassungssystem besteht 
im wesentlichen aus sieben Einheiten: 

- einem fasten Gehause 1 . 

- einem mit dem festen Gehause fast verbundenen und mit einem Terminal- 
organ 2a versehenen sechsachsigen Roboter 2. 

- einer Sensoreinheit 3. die vom Terminaiorgan 2a getragen wird, 

- einem Kalibrierobjekt 4, das seinerseits mit dem festen Gehause 1 fest 
verbunden ist und das in diesem Beispiel auch als Bezugsobjekt verwendet wird, 
wie unten dargestellt wird, 

- einem Rechner 5, 

- mit dem Rechner 5 verbundene Speichermittel 6 

- und ein elektronisches Interface 7 zwischen der Einheit Roboter/Sensor 
und dem Rechner. 

Der Roboter 2 selbst ist von herkommlicher Bauart und umfaBt eine Reihe von 
Betatigungsorganen. die aus einer kinematischen Kette von Motoren besteht. im 
Beispiel aus sechs: 8. 9. 10. 1.1. 12 und 13, die sechs Drehungen um sechs 
Motorachsen ermoglichen. Jeder Motor ist mit einem Sensor der Winkelstellung. 
insbesondere vom inkrementierenden Typ. wie Sensor 18. verbunden^ der Impulse 
abgibt. die fur die Drehung des betreffenden Motors reprdsentativ sind. Der Motor 
8 ist mit dem GehSuse fest verbunden. mit dem ein absolut genanntes 
Bezugssystem (X, Y. Z) verbunden ist. in dem das System die Koordinaten der 
Punkte der zu erfassenden Form angibt, wahrend der Motor 1 3 das Terminaiorgan 
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Im Fall einer Elchung. bei der die Matrix Mjc aus verschiedenen Posltionen des 
Terminalorganes berechnet wird, weist das System die folgenden Merkmale auf: 

■ das genannte System enthalt ein Bezugsobjekt , das mindeslens einen 
charakteristischen Punkt aufweist und Mittel zur Befestigung des Bezugsobjektes 
am Gehause, 

• die Speichermittel umfassen einen Speicherbereich fur die Matrizen 
Mati.--- Mat/. 

• der Rechner ist in der Lage und dafur programmiert. das Gleichungs- 
system nach Mjc aufzulosen. 

Weitere Merkmale, Ziele und Vorteile der Erfindung werden aus der folgenden 
Beschreibung hervorgehen, die auf die beigefugten Zeichnungen Bezug nimmt. die 
als nicht einschrankende Beispiele Ausf uhrungsformen des erfindungsgemaften 
Eichverfahrens darstellen und eine Ausf uhrungsform eines Erfassungssystems. Es 
zeigen in diesen Zeichnungen, die einen integralen Bestandteil der vorliegenden 
Beschreibung darstellen: 

- Fig. 1 eine perspektivische Ansicht eines erfindungsgemafien Erfassungs- 
systems am Beispiel eines sechsachsigen Roboters. 

- Fig. 1a eine Variante des Kalibrierobjektes (Fall dicker MeBstabe). 

- Fig. 1b die Bildung eines virtueilen Kalibrierobjektes aus einem. einzigen 
MeBstab, 

- Fig. 2 eine Detailansicht der am Terminalorgan des genannten Systems 
befestigten Se nsoreinheit als Teil schnittansicht. 

- Fig. 3 ein allgemeines Flu(3.diagramm der Funktionsweise des Erfassungs- 
systems im Mef3.betrieb, 

- Fig. 4 eine perspektivische Ansicht des Roboters wahrend der Eichung 
(Eichungsschritt), 

- Fig. 5a einen Logikplan, der das Rechenprogramm fur den Fall einer 
linearen Zwischentransfertfunktion darstellt, und Fig. 5b eine Darstellung des 
Echos des Kalibrierobjektes in diesem Fall, 

- Fig. 5c das Echo des Kalibrierobjektes im Fall der dicken MeQstabe 
(Fig. 1a). 

- Fig. 6 den Algorithmus der Umsetzung. Aufstellung der Gleichungen und 
Aufldsung im linearen Fall der Fig. 5a, 

- Fig. 7a einen Logikplan. der das Rechenprogramm fur den Fall einer 
nichtlinearen Zwischentransfertfunktion darstellt. und Fig. 7b eine Darstellung des 
Echos, 
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Fur gewisse Anwendungen. die keine Feinkompensierung der Nichtlinean'tdten 
erfordern. bietet die Aufteilung in Elementarzonen einen guten KompromiG 
zwischen PrSzision und Einfachheit der Berechnung. 

Um. bei den Eichmessungen den Quantiflzierungsfehler aufgrund der AuflGsung 
der Sensoreinheit zu begrenzen, erfolgen die Berechnung der Zwischentransfert- 
funktion (N) und die Berechnung der Matrix Myc des Oberganges vom Sensor- 
system zum Terminalsystem vorzugsweise durch Aufstellung abundanter 
Gleichungssysteme und deren Losung im Sinne der kleinsten Quadrate. 

Die Erfindung erstreckt sich auf ein Erfassungssystem der oben definierten Art, 
versehen mit Mittein zur Eichung, die die Anwendung des vorerwahnten 
Verfahrens ermdglichen: 

- ein Kalibrierobjekt, das ein oder mehrere Reliefs bekannler Geometrie 

undAbmessungenaufweist. 

- Mittel zur Befestigung des Kali brierobjektes am Gehause. 

Spelchermittel, einen S peicherbereich fur die Informationen zur 
geometrischen Definition des Kal ibrierobjektes und einen Speicherberei ch fur die 
Matrix (Mjc) cfes Oberganges vom Sensorsystem zum Terminalsystem enthaltend. 

- und einen Rechner, in der Lage und dafur programmiert, die Umsetzung 
der Informationen zur geometrischen Definition in Koordinaten auszufuhren, um 
die Zwischentransfertf unktion N zu berechnen, und die globale Transfertf unktion L 
durch Matrizenmultiphkation zu berechnen. 

Im Fall einer Eichung, bei der die Matrix Mjc aus den Positionsinformationen des 
Kalibrierobjektes berechnet wird. weist das System auUerdem die folgenden 
Merkmale auf: 

• die Mittel zur Befestigung des Kalibrierobjektes sind dazu eingerichtet, 
die Befestigung des genannten Kalibrierobjektes in einer vorher festgelegten, 
bekannten Position relativ zum Gehause sicherzustellen. 

die Speichermittel umfassen einen Speicherbereich fur die 
entsprechenden Positionsdaten des genannten Kalibrierobjektes und einen 
Speicherbereich fur die Matrix M^c des Oberganges . vom Sensorsystem 'zum 
absoluten Bezugssystem. 

• der Rechner 1st in der Lage und dafur programmiert, die Matrix. M^i^c 
bestimmen und die Matrix Mjc .Matrizen M^c Mato zu berechnen. 
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die unbekannten Koordinaten des charakteristischen Punktes des 



Kalibrierobjektes sind, die bei der LGsung des Gleichungssystems durch 
Substitution eliminiert werden. 

Es ist zu beachten. daU das Bezugsobjekt durch das Kalibrierobjekt selbst 
dargestellt werden kann, bei dem gewisse Mefistabe als Bezugspunkte dienen. 

In dieser Ausfuhrungsform wird die mechanische Positionierung des 
Kalibrierobjektes durch eine Reihe von Erfassungen charakteristischer Punkte 
ersetzt, die in verschiedenen. durch die Bewegung der Betatigungsorgane 
erhaltenen Positionen unter denselben Bedingungen ausgefuhrt werden, unter 
denen die tatsachlichen Messungen an einem Objekt erfolgen; diese beliebige 
Positionierung des Kalibrierobjektes fuhrt zu groGerer Flexibilitat des Verfahrens 
(transportables Erfassungssystem. Moglichkeit, das Kalibrierobjekt mit dem zu 
messenden Objekt zu verbinden etc.). 

Im Fail eines Erfassungssystems, in dem die Sensoreinheit ein Beleuchtungs- 
system enthalt, das in der Lage ist. mindestens einen lamellaren Lichtstrahl zum 
Objekt zu senden. und ein Videosystem. das in der Lage ist. das Objekt mit einer 
relatlv zum Strah! des Bel euchtungssystems konstanten Parallaxe zu filmen, um 
Rohinformationen (p, q) in Abhangigkeit von den Spalten (p) und Zeilen (q) der 
Bilder der Punkte der Spur jedes Lichtstrahles auf dem Objekt Oder dem Kalibrier- 
objekt zu liefern, kann die Zwischentransfertfunktion N in linearer Form oder in 
der nichtlinearen Form einer beschrankten Entwicklung oder auch durch 
Unterteilung des Kalibrierobjektes in Elementarzonen ausgedruckt werden. die 
linear oder nichtlinear behandelt werden. oder auch durch Ausfuhrung einer 
Korrektur der Verzerrungen des Systems mittels einer Linearisierungstabelle. 

Die (ineare Form ist ausreichend, wenn die Brennweiten der Videovorrichtungen 
hinreichend groB sind. um die optischen Aberrationen zu begrenzen. Die 
nichtlineare Form erm6glicht es. Videovorrichtungen zu berucksichtigen. die 
erhebliche Verzerrungen oder Optiken mit Anamorphose aufweisen. 



Wenn diese Verzerrungen leicht zu beschreiben sind oder durch die Konstruktion 
geliefert werden. sind die Korrekturen durch Linearisierungstabellen vorzuziehen. 
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In der Folge wird mit "Kalibrierobjekt" ebenso das materielle Kalibrierobjekt mit 
mehreren MeBstSben bezeichnet. wie das virtuelle Kalibrierobjekt. das wie oben 
angegeben aus einem einzigen Meflstab gebiidet wird. 

Im ubrigen wird einer ersten AusfGhrungsform gemad die Matrix Mjc ^^es 
Ubergangs vom Sensorsystem (U, V, W) zum Terminalsystem bestimmt. 

• indem das Kalibrierobjekt in einer vorher festgelegten. bekannten Position 
auf dem festen Gehause befestigt wird und die entsprechenden Daten gespeichert 
werden. 

• indem aufgrund dieser Daten eine Matrix M^c cies Uberganges vom 
Sensorsystem (U, V. W) zum absoluten Bezugssystem (X. Y, Z) fur die 
Kalibrierposition bestimmt und gespeichert wird. 

• indem die von den Besti mmungsmitteln in der Kalibrierposition. gelieferte 
Matrix Mat gespeichert wird, die mit Mato bezeichnet wird. 

• und indem die Matrix Mjc aus den oben genannten Matrizen berechnet 
wird: hAjc = (Mato)'^ *Mac- 

So ist in dieser Ausf uhrung sfornn der absolute Bezugspunkt durch eine prazise 
und vollstandig bekannte Befestigung des Kalibrierobjektes am Gehause gegeben, 
Befestigung. die ohne Schwierigkeiten durch bekannte mechanische Positionie- 
rungsmittel sichergestellt werden kann. 

Dieser Zwang zur prazisen Befestigung des Kalibrierobjektes kann jedoch durch 
Ausfuhrung eines anderen Verfahrens zur Bestimmung der Matrix Mjc vermieden 
werden, das darin besteht, 

• mindestens einen charakteristischen Punkt eines Bezugsobjektes in / 
Positionen der Sensoreinheit zu erfassen. um die die entsprechenden Echos 
darstellenden Rohinformationen (p^. qi.... Pf^, q^f.... p/. q/) zu erhalten, 

• mittels der Zwischentransfertfunktion N die entsprechenden Koordinaten 
(ui. v^. Wi.... u/f. v^f. w^f.... U/. V/, W/). im Sensorsystem zu berechnen. 

• die fur jede der Erfassungspositionen von den Bestimmungsmittein 
gelieferten Matrizen (Matl- ■ Mat/c. Mat/).2u speichern. 

• das folgende Gleichungssystem zu Idsen. um die Unbekannte Mtc 2:u 
berechnen 

Yo = [MatJ • Mtc ^<k<^ 
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• die Zwischentransfertfunktion N mit einerseits der Obergangsmatrix Mjq 
und andererseits der Obergangsmatrix M^t multiplizieren und die globale 
Transfertfunktion L = Mat'Mtc"N zu erhalten. 

Auf diese Weise wird im erfindungsgemafien Verfahren die Kenntnis der 
geometrischen Parameter der Sensoreinheit (die schwer und nur ungenau 
gemessen werden konnen) durch die eines einfachen und leicht prazise zu 
bemafienden Kalibrierobjektes ersetzt. Die Aufstellung der Zwischentransfert- 
funktion erfolgt direkt durch eine Erfassung der Rohinformationen unter denselben 
Bedingungen, wie die spateren Messungen der Punkte eines Objektes, so daB 
dadurch die Fehlerhaufung vermieden wird (da die Fehler der tatsachh'chen 
Messung durch die identischen Fehler kompensiert werden, die bei der Erfassung 
des. Kalibrierobjektes au ft re ten). 

Das Kalibrierobjekt . kann insbesondere ganz einfach aus einer Platte bestehen. 
die auf einer Seite ein Netz von Medstaben tragt: Die Informationen zur Definition 
des Kalibrierobjektes bestehen dann aus den Koordinaten (u^^. V;^) jedes 
MeBstabes in einem Bezugssystem des Kalibrierobjektes (U. V), das sich in der 
Ebene der Flache des Kalibrierobjektes befindet. die das Netz von. Mefistaben 
tragt. 

Im Fall eines quadratischen Netzes genugt eine einzige Information, namlich der 
Rasterschritt des Netzes. 

Es ist ebenfalls moglich, eIn virtuelles Kalibrierobjekt aus einem einzigen Mefistab 
zu bilden, indem die Sensoreinheit in mehreren bekannten Eichpositionen 
angeordnet wird, indem als definierende Information Koordinaten (u/^. V;^) 
gespeichert werden, die in den verschiedenen Eichpositionen in einem mit der 
Sensoreinheit verbundenen Bezugssystem (U, V) verbunden sind. indem die die 
Echos des einzigen Mefistabes, die von der Sensoreinheit in den verschiedenen 
Eichpositionen erfafit werden, darstellenden Rohinformationen (p, q . ) gespei- 
chert werden und indem diese Rohinformationen zusammengesetzt werden, um ein 
virtuelles Netz zu bilden. das das virtuelle Kalibrierobjekt darstellt. 

Diese Art der DurchfOhrung vereinfacht noch die materielle AusfOhrung de$ 
Kalibrierobjektes, indem die mechanischen Bewegungen der Sensoreinheit 
verwendet werden. 
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Ein anderes Ziel ist es, einen. Obergang zum absoluten Bezugssystem des 
GehaUses zu ermoglichen. ohne die Merkmale der Befestigung Oder des Anflan- 
schehs der Sensoreinheit am beweglichen Terminal zu kennen. der sie tragt. 

Die Erfindiing beabsichtlgt dadurch, die moglichen Bewegungen des Systems zu 
erweitern, indem die Sensoreinheit. (in an sich bekannter Weise) auf einem 
beliebigen bewegiichen Terminalorgan (Roboter, Werkzeugmaschine etc.) 
angeordnet werden kann. dessen Kinematik selbst vorbestimmt ist,. 

Zu diesem Zweck besteht das Verfahren zur Eichung eines Systems zur 
Formerfassung des vorgenannten Typs zur Aufstellung der - globalen 
Transfertfunktion zwischen den zuruckgeworfenen Echos und den entspfechenden 
absoluten Koordinaten (x, y, z). die das Erfassungssystem ausgeben soil, darin, 

• vorab Informationen geometrischer Art uber ein Kali brierobjekt zu 
speichern, das ein oder mehrere Reliefs bekannter Geometrie und Abmessungen 
aufweist, 

- die Form des genannten Kalibrierobjektes mittels der Sensoreinheit zu 
erfassen. die in mindestens einer bestimmten Position relativ zum genannten 
Kalibrierobjekt. Eichpositlon(en) genannt. angeordnet ist. um die e ntsprechenden 
Rohinformationen (p. q ..). die die von der genannten Sensoreinheit erfaftten 
Echos darstellen. zu speichern. 

• fur jede genannte Eichposition die das Kalibrierobjekt definierenden 
Informationen in Form von Koordinaten (u, v, w) in ein mit dem Sensor 
verbundenes und Sensorsystem (U. V. W) genanntes Bezugssystem umzusetzen. 

aus den Ergebnissen der genannten Erfassung und den das 
Kalibrierobjekt charakterisierenden Koordinaten (u. v. w) im Sensorsystem eine 
Zwischen transfertfunktion 
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u = F (p. q...) 
V = G (p. q...) 
w = H (p, q...) 



zu berechnen, die die Koordinaten (u. v, w) im Sensorsystem (U, V, W) in 
Abhdngigkeit von den Rohinformationen (p, q) liefert, 

• die Position, des Sensorsystems (U. V. W) im Terminalsystem (R. S. T) zu 
bestimmen und eine Matrix Myc ^i^r den Obergang vom Sensorsystem zum 
Termin.alsystem zu speichern, - 



DIese Systeme weisen ein bislang schlecht gelostes Problem auf. das darin 
besteht. die von der Sensoreinheit gelieferten Rohinformationen (die von dieser 
Sensoreinheit abhangig sind) mit den tatsachlichen Positionen der Punkte der 
Oberflache des Objektes (unabhangig von der Sensoreinheit, die die Erfassung 
ermoglicht hat) in Beziehung zu setzen, d.h. aus diesen Rohinformationen die 
metrischen Koordinaten dieser Punkte in einem bestimmten Bezugssystem zu 
gewinnen. 

Die bekannten Systeme. insbesondere vom oben erwahnten Typ. stellen die 
Beziehung zwischen den Rohinformationen und den tatsachlichen Koordinaten der 
Punkte durch vorherige Kenntnis der Geometrie des Beleuchtungssystems relativ 
zur Videovorrichtung her (vorherige Bestimmung der Parallaxe. der Brennweite 
des Objektivs, der Eigenschaften des photosensiblen Bauteiles etc.). Diese 
Systeme machen a!so die Messung der Gesamtheit dieser Parameter erforderlich, 
urn sie zu eichen. was in der Praxis schwierig ist und eine Fehlerquelle darstellt 
und zu komplexen trigonometrisch en Berechnungen mit Fehlerhauf ung fuhrt.- 
Dadurch ist die Transfertfunktion zwischen den Rohinformationen und den 
tatsachlichen Koordinaten nur approximativ. Um die absoluten Koordinaten der 
Punkte der Oberflache zu erhalten. mussen aufierdem die Positionsmerkmale der 
(beweglichen) Sensoreinheit relativ zum mit dem Gehause verbundenen absoluten 
Bezugssystem bestimmt werden und die bekannten Erfassungssysteme konnen 
diesen Ubergang nur fur einfache Bewegungen der Betatigungsorgane ausfOhren. 
die ejnfachen und vollkommen definierten Relativbewegungen der Sensoreinheit 
(reine Drehung oder Translationsbewegung der Sensoreinheit relativ zum Objekt) 
entsprechen. Diese Einschrankung schrankt den moglichen MeGbereich des 
Systems ein. und dies kann ein Hauptnachteil bei Objekten komplexer Form sein. 

Die Erfindung zielt darauf ab, ein neues Eichverfahren zu schaffen. das es 
eriaubt, die oben erwShnten Nachteile der bekannten Formerfassungssysteme zu 
uberwinden, 

Ein Ziel der Erfindung ist insbesondere. eine Eichung zu schaffen. die vom 
inneren Aufbau der Sensoreinheit unabhangig ist und die dementsprechend keine 
vorherige physische" Messung ihrer geometrischen Parameter erfordert. 



